//
// Created by liuyu on 2024/6/6.
//

#include <stdio.h>
#include "init.h"
#include "rgb.h"
#include "motor.h"
#include "power.h"
#include "rs485.h"

#define TEST_MOTOR_SP 5000
#define TEST_DELAY_MS 2000


/**
* @brief 测试程序
* @param test
* @param void
* @return void
* @retval
* @bug
*/
void test(void)
{
    // 开始测试
    // 呼吸灯
    breathingLamp();
    // 马达方向1
    motorSpeed(MOTOR_TIM8_CH1,TEST_MOTOR_SP);
    HAL_Delay(TEST_DELAY_MS);
    // 马达方向2
    motorSpeed(MOTOR_TIM8_CH2,TEST_MOTOR_SP);
    HAL_Delay(TEST_DELAY_MS);
    // adc采样电压和电流转换
    printf("电压 = %0.2f\r\n",getVoltage());
    printf("电流 = %d\r\n",getCurr());

    // 关闭测试
    setRGBColor(0,0,0);
    motorSpeed(MOTOR_TIM8_CH1,0);
}

void userInit(void)
{
    rgbInit();
    motorInit();
    rs485Init();
}